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ABSTRACT 


A program  was  developed  to  improve  the  on-line 
measurement  capability  of  the  three-dimensional, 
underwater  tracking  ranges  at  the  Naval  Torpedo 
Station,  Keyport,  Washington-  The  program  utilizes  a 
Kalman  filter  routine  to  minimize  the  effects  of 
measurement  noise  in  determining  the  true  target 
position.  The  gain  schedule  used  by  the  filter  is 
calculated  off-line  and  may  be  varied  bhsed  on 
tracking  requirements.  Listings  of  both  of  the 
Fortran  programs  are  included. 

Simulated  exercises  were  run  utilizing  a variety 
of  gain  schedules.  Results  of  these  simulations  will 
assist  NTS  engineers  in  the  implementation  and 
operation  of  the  program  using  the  NTS  computer 
facility.  Details  of  the  simulation  procedure  and  a 
listing  of  the  track  generator  program  are  included. 
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I.  I NT HOD OCT I ON 


The  Naval  Torpedo  Station,  Key  port,  Washington  currently 
operates  two  three-dimensional  underwater  tracking  ranges 
with  the  capability  of  accoustically  tracking  torpedoes  and 
similar  water-borne  targets.  The  computer  system  in  use 
provides  a printed  record  and  plotted  display  of  the 
measured  track.  As  with  most  tracking  systems  the  measured 
data  is  corrupted  by  noise.  This  noise  is  due  to  the 
combined  effects  of  environmental  factors  and  the 
measurement  instruments. 

These  noisy  tracks  are  later  analyzed  to  remove  those 
measurements  judged  to  be  most  inaccurate  on  the  basis  of 
total  track  statistics.  Thus,  it  is  only  at  some  later  time 
that  a smooth  representation  of  the  track  is  available. 

In  the  near  future  an  updated  computer  system  will  be 
brought  on-line.  The  necessity  of  designing  new  programs 
provides  the  opportunity  for  expanding  the  real-time 
capability  of  the  system.  It  is  desired  that  a smoother 
track  be  available  in  real-time  without  the  loss  of  any  of 
the  measured  data.  A long  range  prediction  capability  and 
the  ability  to  handle  various  data  rates  is  also  desirable. 

The  above  requirements  and  the  ready  access  to  the  noisy 
measurements  of  target  position  indicate  the  applicability 
of  a Kalman  filter  routine  to  improve  the  real-time 
capability  of  the  three-dimensional  tracking  ranges  at  NTS. 
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II.  THEORY 


The  development  and  use  of  the  equations  used  in  the 
Kalman  filter  have  been  widely  documented.  Rather  than 
include  the  derivation  here  the  reader  is  referred  to  [1/2] 
or  similar  works. 

In  this  presentation  the  equations  used  will  be  listed 
with  a brief  description  of  each.  The  system  is  assumed  to 
be  linear  and  free  of  deterministic  forcing  inputs. 

We  characterize  the  state  by  the  following  state 
difference  equations 

X (k+ 1)  = PHI  * X(k)  + GAMMA  * W (k) 
and  noisy  measurement  equations 

2 (k)  = C * X (k)  + V (k) 


where 


time  K 


time 


X (k)  is  the  n-dimensional  state  vector  at  time  K 
Z(k)  is  the  m-dimensional  measurement  vector  at 

7 (k)  is  the  m-dimensional  random  noise  vector  at 


W (k)  is  the  m-dimensional  random  forcing  input  at 
time  K,  and 

PHI  and  C are  constant  matrices. 

Tne  estimator  equations  are  given  by 

X (k  | k)  = X (k|  k-1)  ♦ G(k)*[Z(k)  - C * X(k|k-1)] 


where 


X (k| k-1)  = PHI  * X (k- 1 1 k- 1 ) / 


X(k|k)  is  the  estimate  at  time  K given 


measurements 

A 

X(k|k-1)  is  the  estimate  at  time  K given  K-1 


measurements,  and 

G(k)  is  the  Kalman  filter  gain  at  time  K. 

The  estimator  is  initialized  by  setting  X (0 1 — 1 > equal  to 
the  mean  of  the  random  target  entry  points. 

The  gain  (G)  and  theoretical  covariance  of  error  (P) 
equations  are  given  by 

G (k)  = P ( k | k—  1 ) * c'*  [C*P  (k  | k-  1)  *C  ♦ R (k)  ]-» 

P (k  | k)  =[I  - G (k)  *C]*P  (k|  k-1) 

P (k+ 1 1 k)  = ?HI*P  (k|  k)  *PHIT  + Q 

where 

H (k)  is  the  covariance  of  the  measurement  noise, 
P(k|k)  is  the  theoretical  covariance  of  the 
estimation  error,  and 

Q is  found  by 

T 

Q = GAMMA*COV  (H)  *GAMMA 

where  cov(H)  is  the  covariance  of  the  forcing  input.  In 
this  application  the  measurement  noise  causes  fluctuations 
in  the  velocity  estimate  suggesting  that  there  is  an 
acceleration  input.  This  "acceleration"  is  treated  as  a 
random  forcing  input. 

GAMMA  is  given  by 

• 

T2/2 
T 

These  equations  are  initialized  by  setting  P (0 | — 1 ) egual 
to  the  variance  of  the  intiial  state  estimate. 


III.  PROBLEM  DEFINITION 


The  design  and  formulation  of  a new  tracking  program  may 
best  be  defined  in  terms  of  the  present  system  and  the 
improvements  to  be  made.  Details  of  the  reduction  of  the 
accoustically  measured  track  into  the  usable  data  format  of 
XYZ  positioning  on  the  ranges  are  included  in  [3].  It  is 
assumed  that  all  data  has  been  reduced  to  the  three- 
dimensional  coordinates  for  convenient  use  as  track  input  to 
the  program. 

Under  the  present  system,  data  is  received  and  stored  on 
magnetic  tape  for  later  smoothing.  simultaneously,  the 
measured  position  of  the  target  is  printed  with  other 
pertinent  data  (time,  point  count,  array  number,  etc.).  Two 
plots  are  also  generated:  target  position  is  superimposed  on 
a range  chart  in  XY  coordinates;  and,  target  depth  is 
plotted  in  XZ  coordinates. 

The  typical  torpedo  track  will  have  two  modes:  search 
and  pursuit  of  its  target.  The  search  mode  consists  of  a 
helical  track  that  does  not  lend  itself  to  linear 
approximation.  3ecause  this  portion  of  the  track  is  of 
minor  importance  to  range  observers,  any  inaccuracies  caused 
by  a linear  approximation  can  be  tolerated.  The  pursuit  mode 
will  be  a constant  velocity  track  which  can  easily  be 
modeled  by  a linear,  time-invariant  system. 

The  Kalman  filter  (see  Figure  1)  provides  an  accurate 
discrete  approximation  to  the  continuous  target  track. 


The  current  smoothing  techniques  (post-run  analysis) 


remove  those  points  that  are  the  most  corrupted  by  noise. 
This  type  of  routine  initially  considers  all  of  the  measured 
track  points.  The  position  at  any  time  is  then  estimated 
based  on  all  of  the  measurements.  The  resultant  track  is  an 
error  minimizing  curve  fitted  to  the  complete  measured 
track.  The  use  of  the  Kalman  filter  will  not  affect  this 
type  of  post-run  analysis,  as  all  of  the  measurements  are 
retained.  The  filter  will,  in  real  time,  provide  a smoother 
track  through  the  use  of  the  predictor  and  weighted  (the 
Kalman  gain)  correction  factor.  Thus,  by  using  the  filter 
we  are  able  to  overcome  the  problem  of  noisy  measurements 
without  the  loss  of  data. 

Many  of  the  required  computations  can  be  completed 
off-line  so  as  not  to  jeopardize  the  timely  application  of 
the  filter  to  the  track  data.  Because  the  geometry  of  the 
tracking  range  will  remain  the  same,  we  can  utilize 
previously  run  tracks  to  develop  a reliable  set  of 
measurement  noise  statistics.  These  statistics  will  then  be 
used  to  compute  the  Kalman  gain  schedule,  which  may  then  be 
stored  for  use  at  the  appropriate  time. 

Use  of  a priori  knowledge  of  the  noise  statistics  allows 
the  programmer  and  user  not  only  to  precompute  the  gain 
schedule  but  also  to  test  the  program  via  simulation. 
Variations,  such  as  allowances  for  various  degrees  of 
maneuverability,  may  also  be  compared.  Me  are  able  to  base 
the  assumptions  of  measurement  errors  on  noise  criteria 
only,  because  the  assumed  location  of  the  array  hydrophones 
has  been  shown  to  be  highly  accurate.  [4] 

Two  general  assumptions  have  been  made  about  the  noise 
in  the  application  of  the  filter.  First,  it  is  assumed  that 
the  measurement  noise  is  random  with  a mean  of  zero  and  has 
a Gaussian  distribution.  Also,  the  noise  has  been  taken  to 
be  independent  of  the  distance  between  the  target  and  the 


array  sensors.  This  assumption  is  made  with  consideration 
given  to  the  ray  path  reconstruction  routine  used. 


IV.  PROG fi AM  DESCRIPTIONS 


A.  THE  KALMAN  FILTER 

The  Kalman  filter  program  has  been  designed  to  provide 
an  improved  tracking  routine  using  a minimum  of  computer 
storage  and  computation  time.  The  filter  routine  has  the 
capability  cf  processing  a variable  data  rate  limited  only 
by  the  execution  time  of  the  routine  and  the  accuracy 
desired  (in  the  discrete  approximation) . This  data  rate  is 
selected  prior  to  each  run,  as  is  the  advance  prediction 
feature. 

In  addition  to  the  normal  one-step-ahead  prediction  of 
the  filter,  the  user  may  select  a long  range  predictor  prior 
to  each  track  run.  This  feature  will  enable  observers  to 
evaluate  qualitatively  parameters  such  as  torpedo  homing 
capability  during  the  test  run.  The  long  range  predictor 
simply  advances  the  current  filtered  position  the  desired 
number  of  sample  intervals.  The  current  filtered  velocity 
estimate  is  used  in  this  prediction. 

The  operation  of  the  filter  may  adversely  be  affected  by 
large  scale  measurement  errors.  Range  operations  experience 
indicates  that  measurement  errors  on  the  order  of  103  feet 
are  occassionally  recorded.  One  error  of  this  magnitude 
would  invalidate  the  filtered  output  for  many  subsequent 
sample  intervals.  Because  of  the  feedback  operation  of  the 
filter  there  must  be  protection  against  this  form  of 
catastrophic  failure. 
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This  protection  is  provided  by  establishing  limits  of 
acceptability  about  each  of  the  measurements.  The  range  of 
this  acceptability  "gate"  is  adjustable  and  may  be  set  by 
the  user  prior  to  each  exercise  run.  (See  Appendix  B on 
program  requirements  for  a further  explanation.) 

Measurements  that  fall  outside  the  gate  are  regarded  as 
unacceptable;  the  gain  schedule  is  set  to  zero  for  that 
measurement  and  the  filter  is  advanced  based  on  prior 
estimates. 

The  program  is  liberally  documented  through  the  use  of 
"comment"  cards.  These  comments  will  enable  any  user  to 
operate  the  program  with  a minimum  of  supportive 
documentation.  It  is  intended  that  only  a basic  knowledge 
of  Kalman  filtering  and  Fortran  programming  are  necessary  to 
operate  the  program.  Ease  of  implementation  has  been  given 
a high  degree  of  consideration  in  the  design  of  the  program. 


B.  THE  GAIN  SCHEDULE 


The  Kalman  gain  schedule  is  calculated  using  a program 
independent  of  the  filter  routine.  This  separate  program 
permits  prior  off-line  computation  and  storage  of  the  gain 
schedule.  For  a given  tracking  run  the  optimal  gain 
schedule  may  be  computed  from  the  matrix  inputs  to  the 
routine.  These  gains  are  then  stored  for  use  during  the 
actual  tracking  exercise.  If  the  user  chooses  to  alter  the 
gain  schedule  used,  the  independence  of  the  gain  program 
from  the  filter  provides  flexibility. 

In  operating  the  filter,  any  gain  schedule  (optimal  or 
sub-optiaal)  may  be  used.  For  example,  a higher  gain  value 
applied  to  each  measurement  would  allow  for  a higher  degree 


of  target  maneuverability,  but  would  provide  less  smoothing. 


This  program  is  completely  self-supportive;  it  reguires 
no  additional  subprograms  or  routines. 


C.  TRACK  SIMULATOR 


A track  simulator  program  is  also  included.  Its 
inclusion  is  not  necessary  to  operate  the  Kalman  filter 
routine  at  NTS.  It  is  included  here  only  to  acquaint  NTS 
engineers  with  the  simulation  technique  used  in  program 
testing  and  verification. 

The  track  generator  uses  a random  number  generator  to 
select  a track  origin.  The  track  is  then  advanced  from  that 
point  based  on  user  selected  X Y and  Z velocities.  The 
actual  track  is  then  corrupted  by  noise  to  provide  noisy 
position  measurements. 

The  actual  track  and  the  measured,  noisy  positions  are 
available  as  program  output. 

This  program  uses  the  subroutine  SNORM,  an  IEM-360 
library  subroutine.  SNORM  is  a random  number  generator  that 
produces  a normal  Gaussian  distribution. 
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V.  SIMULATION  PROCEDURE 


The  Kalman  filter  program  was  designed  to  handle 
efficiently  (in  terms  of  computer  usage)  the  tracking 
measurements  and  to  provide  the  extra  features  desired  by 
NTS  range  observers.  Once  completed  it  was  necessary  to 
verify  accurate  operation  of  the  program  in  an  NTS 
range-type  environment.  One  means  of  verification  was  to 
model  the  working  environment  and  to  conduct  tracking 
exercise  simulation  using  the  model. 

Several  simplifying  assumptions  have  been  made  in  the 
model.  Simplification  was  made  only  where  it  was  determined 
that  no  conflict  existed  with  realistic  operational 
parameters.  The  primary  reason  for  making  these  changes  was 
to  increase  the  readability  of  the  printed  and  plotted 
output  data. 

In  the  test  model,  the  target  track  was  generated  using 
velocity  along  the  range  baseline  only.  Originally  the 
track  was  modeled  with  principal  motion  along  the  range 
baseline  (X-axis)  and  a slight  crossing  trajectory  (Y-axis) . 
By  eliminating  the  Y-component  of  velocity  the  magnitude  of 
the  noise  corruption  is  represented  as  the  full  range  of  the 
absissa  on  the  XY  position  plot. 

The  program  was  tested  using  a track  that  incorporated 
velocity  along  each  of  the  coordinate  axis  but  analysis  of 
the  filtered  output  data  showed  no  change  in  the  performance 
of  the  filter. 

Various  target  velocities  were  used  for  program 
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. verification.  No  differences  in  performance  were  noted  over 
the  velocity  range  from  twenty  to  fifty-five  knots.  The 
final  model  employs  a target  moving  at  forty  knots  (a 
displacement  of  ninety  feet  between  measurements) . 

Two  considerations  were  made  in  computing  the  gain 
schedule  used  in  testing.  Statistical  data  obtained  from 
previous  range  tracking  exercises  was  used  to  initialize  the 
gain  computations.  Additionally  the  Q matrix  was  varied  to 
test  the  the  degree  of  manuverability  that  could  be  handled 
by  the  filter. 

No  attempt  was  made  to  test  directly  the  "gate”  feature 
of  the  filter.  However,  measurements  greatly  corrupted  by 
noise  were  noted  in  each  of  the  simulations,  providing  a 
test  of  the  filter's  ability  to  reject  highly  erroneous 
measurements. 

No  attempt  has  been  made  to  distinguish  which  particular 
array  supplied  the  data.  It  was  noted  in  the  problem 
definition  that  input  data  to  the  filter  was  assumed  to  be 
in  three-dimensional  range  coordinates.  It  has  been  assumed 
that  current  methods  of  calculating  three-dimensional  data 
will  be  retained  and  will  provide  measurement  input  to  the 
filter  in  terms  of  the  range  baseline  coordinate  system. 
Based  on  this  assumption  there  is  no  need  to  determine  which 
array  supplied  the  data. 

The  primary  purpose  of  the  simulation  has  been  to  test 
operation  of  the  filter  in  such  a manner  that  it  might  be 
implemented  at  NTS,  Kevport  with  only  minor  changes. 
Attempts  have  been  made  to  anticipate  and  to  resolve  any 
problems  that  might  arise. 
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VI.  SIMULATION  RESULTS 


i— 


After  the  Kalman  filter  program  had  been  designed  and 
checked  for  Fortran  and  logic  errors,  it  was  necessary  to 
test  it  in  an  environment  similar  to  that  seen  in  actual 
range  operations.  Computer  modeled  simulations  provided  a 
rapid,  lcw-cost  method  for  verifying  the  accuracy  of  the 
program.  Several  tests  were  run  using  a variety  of 
operational  parameters,  as  explained  below. 

Most  of  the  measured  data  from  the  NTS  ranges  is 
received  at  about  1.3  second  intervals.  The  few  remaining 
exercises  utilize  a data  rate  one-half  the  above.  These 
data  rates  establish  the  absolute  limits  of  any  processing 
routine.  One  of  the  important  aspects  of  the  simulation  is 
the  cycle  time  of  the  filter. 

All  of  the  simulation  exercises  were  conducted  using  the 
I3M-360  system  at  the  Naval  Postgraduate  School  under  a 
time-shared  mode.  The  tests  were  conducted  at  various  times 
of  the  day  when  system  user  load  ranged  from  moderate  to 
heavy. 

The  average  time  of  operation  of  the  filter  was  1.4240 
hundredt hs-of-a-second.  Given  this  wide  margin  of 
acceptability,  it  is  assumed  that  no  difficulty  will  arise 
when  the  filter  is  operated  on  the  NTS  range  computer 
system. 

In  the  Kalman  gain  schedule,  the  steady-state  values 
were  achieved  after  seven  to  twelve  sample  intervals 
depending  on  the  input  values  assigned  to  the  Q matrix.  The 
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gain  schedule  shovn  in  Table  1 is  based  on  a target  that  is 
expected  to  undergo  little  or  no  maneuvers  (accelerations  of 


less  than  3.2  feet/second2)  . For  all  measurements  after  the 
last  indicated  time  the  gain  values  are  equal  to  the  last 
value  listed. 


TIME 

POSITION 

VELOCITY 

GAIN 

GAIN 

1 

0. 990099 

o 

t 

o 

2 

0.994248 

0.754539 

3 

0.835858 

0.398822 

4 

0.725189 

0.284304 

5 . 

0.669428 

0.252953 

6 

0.649976 

0.248808 

7 

0.646037 

0.249742 

8 

0.645805 

0.250140 

9 

0.645766 

0.250005 

10 

0.645621 

0. 249853 

11 

0.645519 

0.249798 

12 

0.645481 

0.249792 

13 

0.645474 

0.249794 

14 

0.645474 

0.249794 

15 

0.645474 

0.249794 

Table  1 - GAIN  SCHEDULE  FOR  A NON-MANEUVERING  TARGET 
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Two  other  gain  schedules  were  used  in  the  simulation  and 
are  shown  in  Tables  2 and  3.  These  schedules  assume  target 
accelerations  of  10  feet/second2  and  20  feet/second2/ 
respectively.  Again  the  last  values  shown  are  the 
steady-state  values  and  are  to  be  applied  to  all  subsequent 
measurements.  . 


A.  NON-MANEUVERING  TARGET 


When  the  target  is  in  a non-maneuvering  mode  the  only 
fluctuations  from  its  track  will  be  due  to  noise.  Because 
this  noise  corruption  is  undesirable,  the  gain  schedule  used 
should  provide  for  maximum  smoothing  of  the  target  track. 

The  gain  schedule  (Table  1)  was  calculated  assuming  that 
the  initial  position  estimate  could  be  determined  within 
±100  feet  of  the  actual  position.  By  assuming  that  the 
variance  due  to  the  noise  would  be  approximately  three 
feet/second2,  maximum  smoothing  with  an  allowance  for  slight 
irregular  target  accelerations  was  achieved. 

Using  these  gains  with  a simulated  noisy  track,  the 
filtered  position  estimates  were  statistically  compared  with 
the  measured  positions  and  the  known  true  track.  The 
deviation  of  the  filtered  track  points  from  the  true  track 
was  approximately  one-half  that  displayed  by  the  measured 
positions.  The  standard  deviation  of  the  filtered  track 
estimates  about  the  true  track  was  approximately  equal  to 
the  theoretical  value  predicted  in  the  calculation  of  the 
gain  schedule.  This  favorable  comparison  of  experimental 
and  theoretical  values  indicates  that  proper  initial  values 
have  been  used  in  calculating  the  Kalman  gain  schedule. 
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TIME 

POSITION 

VELOCITY 

GAIN 

GAIN 

1 

0. 990099 

© 

• 

o 

2 

0. 994273 

0.757905 

3 

0.869084 

0.548191 

4 

0.84301 1 

0.553351 

5 

0.842683 

0.555230 

6 

0.842387 

0.554583 

7 

0.842279 

0.554577 

3 

0.842276 

0.554587 

9 

0.842275 

0. 554585 

10 

0.842275 

0. 554585 

11 

0. 842275 

0. 554535 

Table  2 - GAIN  SCHEDULE  FOB  A MANEUVERING  TARGET 
(APPROXIMATELY  1/3G  ACCELERATION) 


TIME 

POSITION 

VELOCITY 

GAIN 

GAIN 

1 

0. 99099 

0.0 

2 

0.994342 

0.767076 

3 

0.915940 

0.759631 

4 

0. 915308 

0. 765307 

5 

0.914846 

0. 764878 

6 

0.914830 

0.764944 

7 

0.914828 

0.764940 

8 

0.914828 

0.764940 

9 

0.914828 

0.764940 

Table  3 - GAIN  SCHEDULE  FOR  A HIGHLY  MANEUVERING  TARGET 
(APPROXIMATELY  2/3G  ACCELERATION) 
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Portions  of  the  noisy  track  and  filtered  track  are  shown 
in  Figure  2.  While  the  noise  corruption  cannot  totally  be 
eliminated,  the  filtered  track  does  provide  a truer 
representation  of  the  actual  target  path.  Purther 
improvement  can  be  achieved  by  applying  current  post-run 
smoothing  techniques  to  this  filtered  track. 


B.  MANEUVERING  TARGET 


* 

<? 


For  tracking  exercises  run  with  a target  that  is  known 
to  be  maneuvering,  the  gain  schedule  can  be  adjusted  to 
follow  those  maneuvers.  If,  for  example,  the  exercise  is  to 
be  run  with  a MK  30  simulator  programmed  for  maneuvers 
involving  accelerations  of  less  than  10  feet/second2,  a gain 
schedule  as  listed  in  Table  2 would  be  used.  The  higher 
gain  values  needed  would  reduce  the  quality  of  the  real-time 
smoothing. 

The  degree  of  smoothing  accomplished  can  be  seen  in 
Figure  3,  a comparison  of  portions  of  the  tracks  obtained 
from  raw,  measured  data  and  data  smoothed  using  the  gains 
derived  for  a maneuvering  target. 

The  reduction  in  the  quality  of  smoothing  may  be  seen  in 
Figure  4.  These  filtered  tracks  were  obtained  using  the 
maneuvering  and  non-maneuvering  gain  schedules.  Both  tracks 
were  obtained  from  the  same  set  of  noisy,  measured  data. 

Again,  the  deviation  of  the  filtered  track  points  about 
the  true  track  is  less  than  that  displayed  by  the  measured 
positions.  Favorable  comparison  was  made  between  the 
experimental  and  theoretical  values  of  the  error  statistics. 
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MEASUREMENTS 

Figure  2 - COMPARISON  OF  THE  MOIST  AND  FILTERED  TRACK  POINTS 
FOR  A MON-MANEUVERING  TARGET 


The  gain  schedule  used  to  produce  the  smoothed  track 
above  is  for  a non-maneuvering  target.  The  degree  of 
smoothing  attained  is  seen  by  comparison  of  the  measured 
track  points  (X)  and  the  filtered  track  points  (curve). 


The  gains  listed  in  Table  1 were  used  to  filter  this 
data.  This  plot  represents  the  maximum  smoothing  achieved 
i_~  the  simulation.  The  magnitude  of  the  T-axis  fluctuation 
is  due  to  measurement  noise  only. 
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Figure  3 - COMPARISON  OF  THE  NOISY  AND  FILTERED  TRACK  POINTS 

FOR  A MANEUVERING  TARGET* 

The  gain  schedule  used  to  produce  this  smoothed  track 
is  for  a maneuvering  target.  Again  comparison  is  made 
between  the  noisy  tracjc  measurements  (X)  and  the  filtered 
track  points  (curve)  . 


The  gains  listed  in  Table  2 were  used  to  filter  this 
data.  Again  the  Y-axis  fluctuation  is  due  to  measurement 
noise  only. 
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Figure  4 - COMPARISON  OF  THE  FILTERED  TRACKS  USING  THE 
MANEUVERING  AND  NON-MANEUVERING  GAIN  SCHEDULES* 

The  plot  shown  above  is  a comparison  of  the  difference 
in  the  degree  of  smoothing  achieved  with  the  gain  schedules 
previously  used.  The  non-maneuvering,  filtered  track  from 
Figure  2 is  displayed  with  a (X)  , and  the  maneuvering 
filtered  track  of  Figure  3 is  shown  by  the  curve. 


* ■ * « 


tit 


c 


HIGHLY-HAflEUVERING  TARGET 


One  additional  simulation  was  run  assuming  a target 
accelerating  up  to  20  feet/second2.  This  high  acceleration 
might  be  expected  if  an  attempt  was  made  to  follow  a torpedo 
through  both  the  search  and  pursuit  phases  of  its  track. 
Allowances  for  high  acceleration  substantially  increase  the 
gain  values  (Table  3) . 

With  these  high  gains  most  of  the  smoothing  effect  of 
the  filter  is  eliminated.  This  point  is  best  illustrated  in 
Figure  5,  a comparison  of  measured  and  filtered  portions  of 
the  simulated  track. 

Care  must  be  exercised  when  the  gains  are  adjusted  to 
follow  large  maneuvers.  If  the  gate  value  is  set  too  low, 
the  filter  will  fail  to  function.  In  this  test  it  was 
necessary  to  double  the  value  of  the  gate  limits  (±100  feet) 
used  in  the  two  previous  simulations.  (Further  explanation 
of  the  gate  feature  is  included  in  Appendix  B.) 
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Figure  5 - COMPARISON  OF  THE  NOISY  AND  FILTERED  TRACKS  FOR  A 

HIGHLY  MANEUVERING  TARGET • 
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The  gain  schedule  used  to  produce  the  filtered  track 
above  is  for  a highly  maneuvering  target.  Almost  a total 
lack  of  smoothing  is  noted  in  comparison  of  the  noisy  track 
measurements  (X)  and  the  filtered  track  points  (curve) . 

The  gain  schedule  listed  in  Table  3 was  used  in 
processing  this  data.  The  ability  to  follow  large  maneuvers 
results  in  the  lack  of  smoothing  seen. 
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VII.  CONCLUSIONS  AND  RECOMMENDATIONS 


The  simulations  conducted  using  the  Kalman  filter 
program  indicate  that  it  will  provide  improved,  real-time 
tracking  data  for  operations  on  the  three-dimensional 
underwater  ranges  at  the  Naval  Torpedo  Station,  Keyport. 
The  filter  accomplishes  a partial  smoothing  of  the  target 
track  in  real-time  as  well  as  providing  the  long  range 
prediction  capability  desired  by  NTS  range  engineers.  Both 
of  these  features  will  substantially  improve  the  quality  of 
service  provided  to  NTS  range  users. 

Additionally,  either  the  filtered  position  estimates  or 
the  actual  measurement  data  may  be  used  in  any  type  of 
smoothing  algorithm  to  obtain  the  type  of  post-run  analysis 
currently  available.  The  smoothing  accomplished  by  the 
filter  will  provide  a higher  quality  input  to  the  post-run 
analysis,  resulting  in  a smoother  final  track  than  has  been 
previously  attained. 

With  the  exception  of  minor  input/output  change 
requirements,  the  gain  and  filter  programs  are  ready  for 
implementation  at  range  computer  facilities  at  NTS. 
Explanation  of  these  changes  is  included  in  tne  program 
requirements.  Appendices  A and  B. 

Based  on  the  assumption  that  the  search  mode  of  any 
torpedo  tracking  exercise  is  insignificant,  the  optimal 
tracking  and  smoothing  can  be  accomplished  using  the  gain 
schedule  suggested  for  a non-maneuvering  target  (Table  1) . 
Before  implementation  additional  testing  and  comparison  may 
be  desirable  using  exercise  data  obtained  under  a variety  of 


operating  conditions  at  NTS. 


In  the  future,  additional  improvement  to  the  tracking 
system  may  he  accomplished  by  altering  the  data  input 
format.  As  stated  earlier,  the  target's  measured  position 
expressed  in  the  three-dimensional  coordinate  system  of  the 
range  was  used  as  input  to  the  Kalman  filter  program. 
Direct  application  of  the  time  signal  to  a filter  sequence 
has  not  been  considered  at  this  time.  This  application  may 
be  considered  as  a possibility  for  futher  program 
development . 

Several  references  have  been  made  to  the  smoothing 
techniques  used  in  current  post-run  analysis.  No  attempt 
has  been  made  to  apply  such  methods  to  the  filter  output  as 
simulated.  It  is  recommended  that  the  filter  be  applied  to 
previously  recorded,  range-tracking  data  and  the  smoothing 
alogrithm  then  be  applied  to  this  filtered  output. 
Comparison  should  then  be  made  between  the  filtered  and 
measured  smooth  curves. 
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APPENDIX  A 


GAIN  PROGRAM  DESCRIPTION  AND  REQUIREMENTS 


The  Fortran  program  GAINS  was  designed  to  compute  a 
Kalman  gain  schedule  based  on  user  selected  input  matrices. 
The  gain  and  covariance  equations  listed  in  Chapter  II  were 
used  in  the  computations. 

The  user  must  input  the  following  integer  variables: 
the  dimension  of  the  state  vector  (N<6) ; the  dimension  of 
the  measurement  vector  (M<3) ; and,  the  number  of  gains  to  be 
calculated  (ITIME<200) . 


ITIHE  will  normally  be  set  only  high  enough  to  insure 
that  the  steady-state  value  of  the  gains  is  reached.  This 
value  will  usually  be  less  than  thirteen.  If  a permanant 

change  is  desired,  the  dimensions  of  GK  and  PKK  (line  2) 
should  be  changed  to  read  "GK  (6 , 3 , XXX) " and  "PKK (6 ,6  ,XXX) " 
where  XXX  represents  the  desired  value. 

1 

I 

Additional  input  requirements  are  the  following 
• matrices:  PHI,  the  state  transition  matrix  (dimensions 

NxN) ; C,  the  measurement  matrix  (MxN) ; R,  the  variance  of 
the  measurement  noise  (MxM) ; PKK HI,  the  variance  of  the 
initial  state  estimate  (NxN) ; and,  Q,  the  variance  of  the 


random  forcing  input  (NxN) . All  of  these  matrices  should  be 
* input  in  fixed  point  arithmetic  with  no  single  value 
„ exceeding  ten  characters. 


* ; * * 4 


two  gains  (position  and  velocity)  and  the  associated 
variances  and  covariance.  If  additional  values  are  desired, 
it  is  necessary  to  change  only  statements  43  and  45  as  noted 
in  the  program  listing.  The  actual  gain  calculations  are 
performed  in  SUBROUTINE  GAIN.  Other  subroutines  are  used  to 
perform  the  necessary  algebraic  calculations. 

The  program  output  will  be  a gain  schedule  and 
theoretical  covariance  matrix  of  the  specified  length 
(ITIME) . These  values  are  output  to  separate  files.  The 
gain  output  is  used  as  input  to  the  filter  program  which  is 
currently  written  to  read  13  gain  values. 
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APPENDIX  B 


KALMAN  FILTER  PROG RAM  DESCRIPTION  AND  REQUIREMENTS 


This  program  requires  input  from  three  sources. 
Thirteen  values  of  the  gain  schedule  are  read  via  file 
three.  The  actual  target  position  measurements  are  input 
via  file  four.  The  program  is  designed  to  terminate  when 
the  measurement  value  of  the  X position  exceeds  10s  feet 
(see  line  95) . Several  values  must  be  input  by  range 
observers  prior  to  each  run.  These  values  are  the  initial 
state  estimate  (six  fixed  point  numbers,  each  of  less  than 
eight  characters) , the  sample  interval,  long  range  predictor 
and  measurement  gate  value  (each  of  fixed  point  numbers  with 
up  to  ten  characters  each)  . 

The  long  range  predictor  is  scaled  in  sample  intervals, 
NOT  units  of  time,  so  care  must  be  exercised  to  obtain  the 
desired  value. 

The  gate  value  is  used  to  reject  measurements  that  are 
obviously  erroneous.  This  value  must  be  set  high  enough  to 
allow  adequate  operation  of  the  filter  and  still  perform  its 
function.  In  the  non-maneuvering  simulation  the  value  was 
set  at  50  feet  with  a standard  deviation  of  ten  feet  in  the 
generated  noise. 


As  written  the  program  output  supplies  the  predicted, 
measured  and  filtered  position  values  and  filtered  velocity 
estimate.  Three  statements  (124,123,130)  output  these 
values  to  one  file  with  all  X values  listed  first  followed 


33 


by  all  Y values  and  then  Z values 


Upon  implementation  at  NTS,  all  filtered  (position  and 
velocity)  and  measured  (position)  values  may  be  output  by 
rewritting  line  124  and  the  associated  FORMAT  statement 
(#300,  line  134) . If  this  change  is  made  lines  127  through 
130,  inclusive,  should  be  deleted. 

The  dimension  statement  (lines  1,2)  should  be  changed  so 
that  XKKM1,  Z,  and  XKK  will  be  able  to  handle  the  expected 
number  of  measurements  in  any  given  exercise  run.  At 
present  they  are  set  at  200  (approximately  four  minutes  with 
a sample  interval  of  1.31072  seconds). 

The  program  contains  additional  comments  to  facilitate 


APPENDIX  C 


TEACK  SIMULATOR  PROGRAM  DESCRIPTION  AND  REQUIREMENTS 


The  simulator  program  requires  no  input.  The  random 
number  generator  (SNORM)  used  to  determine  target  entry 
point  and  measurement  noise  is  seeded  with  two  arbitrary 
values  included  in  the  program  (lines  5,6) . If  the  seeds 
are  changed  they  must  be  odd  integer  values  of  eight  or 
fewer  characters. 

This  pregram  generates  a 200  point  true  track  (X)  and 
adds  random  noise  to  each  track  point  to  obtain  a noisy 
measurement  (Z) . The  two  tracks  are  output  to  separate 
files. 

The  program  contains  additional  comments  to  facilitate 
its  use. 
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APPENDIX  F 


TRACK  SIMULATOR  PROGRAM  LISTING  _ 
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